#include "SERIALAPI.h"
#include "mouse_sensor.h"
#include "debug_frmwrk.h"

void main()
{
    debug_frmwrk_init();
    init_mouse_sensors();
    INITIALISE();
    uint32_t time = 100;
    
    int16_t x = get_total_x();
    int16_t y = get_total_y();
    M1_FORWARD(30);
    //M2_FORWARD(20);

    

    //STOP_MOTORS();
    //y = get_total_x() - x;
    //x = get_total_y() - y;
    
    while(--time)
    {
            UARTPutDec32(LPC_UART0, get_total_x() - x);
            UARTPuts(LPC_UART0, "  :  ");
            UARTPutDec16(LPC_UART0, get_total_y() - y);
            UARTPuts(LPC_UART0, "\r\n");
            time = 100;
    };
    STOP_MOTORS();
}


